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PREFACE 


The work described in this report was performed by the Guidance 
and Control Division of the Jet Propulsion Laboratory. 


V , 


iii 



77-66 


ABSTRACT 


A comprehensive sampled data analysis of a computer-oontrollsd 
manipulator la presented in terms of root loci for gain selection and 
transient responses to step input functions. All parameter values 
and their derivations where applicable are tabulated. The analysis, 
while quite specific, uses normalized gain parameters, which allows 
the results to be applied to any similar system regardless of individual 
hardware parameter values. 
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SECTION I 
INTRODUCTION 


The JPL Robot Research Program has the goal of applying robotics 
to space exploration. As space mission requirements become more complex 
and communication delays become longer, spacecraft must have more autonomy 
to be able to perform useful tasks. Both these problems, complexity and 
communication delay, are present in planetary surface rovers. For example, 
a rover must coordinate the functions of manipulation, vision, and loco- 
motion in order to carry out tasks of scientific interest. Furthermore, 
at earth-Mars distances, communication delays range from 8 to ^<0 rain, 
limiting direct control to very simple tasks. 

Since a planetary rover is an obvious candidate for robotic appli- 
cations, the JPL Robot Research Program has developed a breadboard Mars 
roving vehicle. This breadboard development was chosen to give focus to 
the program, and also represents the problem of developing basic robotic 
capabilities (manipulation, vision, and locomotion) and coordinating their 
operation. Typical surface exploration tasks were selected, consisting 
of sample (rock, etc.) handling, and instrument assembly and deployment. 
Sample handling and assembly impose stringent requirements on manipulator 
motion. For saniple handling, the manipulator must operate in an impre- 
cisely known environment, avoiding obstacles which change at various 
times. During assembly tasks, the environment is fairly well known, but 
precise parts placement is important. Both of these tasks then impose 
requirements for precise control over the manipulator's motion: sample 

handling during the large motions and assembly at the motions' end points. 
Additionally, the desired space application necessitates a simple program, 
one which need not be run by a large computer. Meeting the precise 
control requirements requires a thorough knowledge of the control stability 
and transient response characteristics of the closed-loop feedback system. 

It Id th? intent of this report to present that information. 

Since ti.e primary purpose of the rover development was to build an 
overall rover system, subsystem technology was adapted from existing de- 
signs wherever possible. The JPL rover manipulator design was based on 
work originally done at Stanford University's Artificial Intelligence 
Laboratory. Since JPL's requirements differed from those of Stanford, 
additions and changes were made in the course of developing JPL's manipu- 
lator system. 

The Stanford design consists of a six- jointed, boom-configured mani- 
pulator. All six links move simultaneously, providing coordinated motions. 
The original control technique (Ref. 1) used a full representation of the 
manipulator's mechanical and inertial characteristics. As development pro- 
ceeded, it became apparent that the performance was not satisfactory, which 
dictated changes verified by analysis. Because of the increased control 
loop response, simpler control techniques could be employed which placed 
more reliance on standard servo loops to control the motion of the indivi- 
dual links. Eventually, the very complicated model of inertias, reaction 
torques, and driving torques was eliminated, which resulted in a considerable 
savings in computer storage and computation time. 
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SECTION II 

EVOLUTION OF THE PRESENT CONTROL SYSTEM 


The original syatera control softoiCro, as developed at Stanford, 
modeled the entire manipulator in terras of inertia, reaction torques, 
gravity torques, friction torques, and motor characteristics. In essence, 
it was supposed to compute the torque characteristics necessary to perform 
a maneuver in an open-loop manner, and if done correctly, the manipulator 
could move very rapidly with no error. However, position and rate 
feedback were included to compensate for model errors. The first JPL 
version of the control system was the same as the Stanford system from 
which it was copied, except for the addition of tachometers in place of 
numerical differentiation to obtain rate feedback. Over a period of time, 
other changes were made which resulted in the present simpler system. 

The first modification made at JPL was to change from voltage drive 
to current drive amplifiers. A complete sampled data analysis done with 
voltage drive showed that the gains would have to be changed for large 
changes in inertia regardless of the fact that the inertia was continually 
computed and used as a gain multiplier. Another advantage of current drive 
was the elimination of the motor back electromotive force (EMF) compensation. 
The second modification was to eliminate the friction compensation in the 
control software and increase the gains for better performance. Unexpectedly 
high frictional torque was encountered in the harmonic drive speed reduc- 
tion gears. This was a sinusoid with angular motion, thus making the fric- 
tion compensation useless since it used only a constant. Also the friction 
in sliding joint 3 was very erratic. Considerably higher gains were required 
to increi’ise the response to these large and varying frictional torques. 

The sampled data analysis done at that time was for a system with 
1-cycle delay since all the signals were computed in sequence, then all 
were sent out in sequence at the end of the sampled interval, resulting in 
a full sampling interval delay. The root locus plots clearly indicated that 
the gains could not be increased very much, so an analysis with no delay 
was performed. This showed that a much better response could be obtained 
with no delay. The solution was to change the program to compute each error 
signal and immediately send out the result to that Joint. This procedure 
was repeated for each joint in turn. The result was a sy.stem with approxi- 
mately 0.10-cycle delay with a sampling rate of 62.5/s. Another analysis 
was now required which used a variable delay. Its root loci indicated, 
as expected, a less responsive system than for zero delay, but still consid- 
erably better than the original 1-cycle delay system. Later, the sampling 
rate was doubled to 125/s, which required additional loci with the delay 
now increased to 0.2. Despite the fact that the analysis indicated suffi- 
cient stability margin with new high gain values, lower values were used 
because the software continually computed very high erratic error signals. 
This was traced to noise in the system, particularly ground-loop noise. A 
solution was to introduce the rate error integral gain Kjy. Its effect was 
to increase the effective position gain (Kg + Kjy) , but the noise was re- 
duced by the integration process. Again this necessitated an expansion of 
the analysis and considerably more effort to display the root loous charac- 
teristics and transient step responses. 


2-1 



77-66 


SECTION III 
SYSTEM ANALYSIS 


The analysis presented here uses conventional techniques for deter- 
mining system gains and the resultant stability margin, and the steady- 
state and transient behavior. Modified Z transforms are used since the 
system employs sampled data with a fixed computation delay which is a small 
fraction of the total sampling interval. Root locus plots in the Z-planc 
unit circle indicate relative stability, and responses to step displacements 
and disturbance torques indicate transient and steady-state response. 


A. SYSTEM PARAMETERS AND TRANSFER FUNCTION 

A flow diagram of the present manipulator control system is shown 
in Fig. 1. It indicates the following three distinct portions of each 
control loop: 

(1) The software or digital control located in the General Automa- 
tion SPC-16/85 minicomputer. 

(2) The manipulator joint drive motor, along with its current drive 
amplifier, and the tachometer and angular position potentiometer 
for feedback of rotation rate and angle, respectively. 

(3) The Interface between the computer and the manipulator, con- 
sisting of digital- to-analog and analog-to-digital (A/D) con- 
verters. 

The digital control implies a finite sampling time or computation 
cycle time shown by the sampler with period T in seconds. The sampling 
rate is then the reciprocal of T. 

Figure 2 replaces the various software and hardware blocks in Fig. 1 
with their respective Laplace transforms. A minor point is that the A/D 
converters do not continuously update but read only every T seconds, which 
would require that the sampler switches be placed on the other side of 
the converters. However, the effect is the same, and the sample and hold 
are done appropriately in the analysis. Figure 2 can be reduced to the 
simple flow diagram presented in Fig. 3(a), 

Figure 3(a) represents the actual control system configuration. The 
approach here is to analyze this system for stability by deriving the charac- 
teristic equation and plotting parametric root loci in the unit Z-plane 
circle. Along with this, the transfer function for a step displacement 
and a step disturbance torque will be derived using configurations 3(b) 
and 3(c), respectively. The transient response to these step inputs can 
be computed easily from the Z transfer function and plotted using a 
general-purpose computer with its plotting equipment. The overall sampled 
data transfer function for Fig. 3(a) is 
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COMPUTER INTERtACE MANIPULATOR 

DIGITAL CONTROLLER f I 



Figure 1 . Phyaical Configuration of Manipulator Control Loops 



Figure 2. Analysis Configuration of Manipulator Control Loops 
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Figure 3* Control System Plow Diagram for Various Inputs 
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whe! « the starred transform C*(s) represents the ordinary Laplace trans- 
form of the sampled signal e*(t). 

deferring to Fig. 2, the individual Laplace transfer functions are 
X n Speed reduction gear ratio 

K? 

^2 * ~~ Motor and forward loop gains 

Js2 

Kjv 

G 3 X Ky ♦ — Rate error proportional plus integral gains 
8 

l^le 

G|( X Ke ♦ — Position error proportional plus integral gcins 
s 

G 5 X -K 3 A 3 G<j '8 Rate feedback gain 
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C6 

= s 

Analytic differentiation of input function 

G7 

= 1 

Unity gain 

08 

- ~K-|Ai0p 

Position feedback gain 


1 - e-^T 


Oho 

s 

Zero-order hold 

O9 

1 

Constant to convert torque to current, A 

Kj 



As indicated in the definitions for the constant multipliers 
Ki, K2 i and K3, these constants are for unitizing or essentially can- 
celing the gains due to the various hardware elements and also to 
Introduce the gain multiplier Jj'Kj. The effect of this is bo make 
each control loop a lunation '*ff only the gains Kg, Ky, Kie> and Kjv 
Now the following element transfer functions reduce to 

j' K-r 1 
^ Kx Js2 n 


Gg = -ns 
Gg = -1 

The gear reduction ratio (n) now cancels from the transfer function, 
but most importantly, each manipulator joint servo loop is dependent only 
on the multipliers, 

Kf , Angular position error gain, s“2 

Kie Angular position error integral gain, s“3 

Ky Angular rate error gain, s“1 

Kjy Angular rate error integral gain, s“2 

Thus, if the multiplier J/Kj is equal to the reciprocal of the ratio 
K^/J (actual motor torque constant/actual total inertia at the motor shaft) 
for each control loop and the same gain values are used, all manipulator 

joints will have the same stability margin and identical transient responses,. 

This is a very desirable situation, unless hardware limitations such as an 
underpowered motor drive dictate decreased gains and slower response for 
a particular joint. 

1 

In general, the parameter for each motor is known quite accurately, 
but the inertia for some joints can change significantly, as indicated in 
Table 1. Since the inertia value is no longer computed continuously, a 
constant average value will be used. The approach is to multiply all four 
gains by this deviation factor. The effect on stability is easily obtained 
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Table 1. Values for Unitizing Multipliers K-] , K 2 , and K 3 , and for Parameters Used in Their Derivation 


Manipulator Joint 


Parameter 

1 

2 

3 

4 

5 

6 

Aj, A/V 

1.5 

1.5 

0.5 

0.2 

0.2 

0.05 

Gp, V/manip-rad 

3.274 

3.274 

0.21 

3.274 

3.274 

3.274 

Gj, V/motor-rad s'"! 

0.034 

0.044 

0.354 

G.064 

0.063 

0.025 

A-] , input-unit/V 

409.6 

409.6 

409.6 

409.6 

409.6 

409.6 

A 2 , V/output-unit 

0.0195 

0.0195 

0.0195 

0.0195 

0.0195 

0.0195 

A 3 , input-unit/V 

409.6 

409.6 

409.6 

409.6 

409.6 

409.6 

n (Qq/Bijj) 

0.010 

0.010 

1 

0.0139 

0.0139 

0.00684 

_/ _ 

Kt = motor-oz-xn./A 

6.8 

15.7 

40. 

10. 

10. 

4.5 

K-fo = K*j>/n, manip-oz-in./A 

680 . 

1570. 

40. 

719 . 

719. 

658 . 

oz-in.-s^ (to motor) 

0.0512 

0.0640 

C.21 

0.00312 

0.00310 

1.34 10“** 

Jg = J^'n^, oz-in.-s^ 

512. 

640. 

0.21 

16.13 

16.06 

2.86 

Jg,® oz-in.-s'^ (to manip) 

201—633 

508—1003 

0.21 

15.1—17.3 

15.9 

2.89 

J/Kx, A s2 

7.53 10-3 

4.07 10-3 

16.5 10-3 

3.12 10 -** 

3.10 lO-'^ 

3.0 10-5 
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Table 1 . Values for Unitizing Multipliers 
(Continuation 1) 

K. 2 , and 

K3, and for 

Parameters 

Used in Their 

Derivation 

Manipulator Joint 

Parameter 

1 

2 

3 

4 

5 

6 

Jq/Jq 0.6l*»2.6 

0.64—1.3 

1.0 

0.93—1.07 

1.01 

0.99 

K^, manip-rad/ input-unit 7.46 10“^ 

7.46 10“** 

0.0116 

7.46 10“** 

7.46 10“** 

7.46 10“** 

K2, output-unit s^ 25.7 

13.9 

0.537 

5.75 

5.72 

4.50 

K3, manip-rad s~ Vinput-unit 7.16 10“** 

5.55 10-** 

69.0 10“** 

5.30 10“** 

6.68 10“** 

6.68 10“** 

n/j( 1/oz-in.-s2 0.19 

0.16 

4.7 

4.5 

4.5 

17.9 

^Inertia of manipulator with no loa. in the 

hand . 







I 
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Table 1. Values for Unitlziiig Multipliers Ki, K 2 , and K 3 , and for 
Parameters Used in Their Derivation (Continuation 2) 


Definition of Parameters 


Ai E 

Gp = 

— 

A1 = 

Ap s 
A3 s 
n = 
K-t = 


/ 


J 


Jo 



Jq/Jq 


J/Kt = 


current drive amplifier gain 

angular position potentiometer for position 
feedback 

angular rate tachometer for rate feedback 
A/D converter for position feedback 
D/A converter for error signal to motor 
A/D converter for rate feedback 
gear, motor to manipulator, stepdown ratio 
nominal motor torque constant 

value of motor torque constant (referred to motor 
shaft) used in computing program constant Kg 

value of inertia (referred to motor shaft) used 
in computing program constant Kg 

value of referred to manipulator joint rather 
than motor shaft 

value of Kx referred to manipulator joint 

range of actual inertia referred to manipulator 
joint 

ratio of constant inertia value used in program 
(for Kg) to actual value as manipulator configura- 
tion changes 

motor characteristic constant used in computing Kg 


A^Gp 


computed constant used to convert units from A/D 
converter back to radians, and essentially unitize 
angular position feedback gain 
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Table 1. Values for Unitizing Multipliers K-j , Kg, and K 3 , and for 
Parameters Used in Their Derivation (Continuation 3) 


Definition of Parameters 


nAgAjK^ 

JQ 

^2AiKtO 


^ = 


n 


A^Gip 


computed constant used to convert error signal 
to proper D/A converter units, and essntially 
unitize all gains in loop except Kg, Ky, Kt 
and Kt 

computed constant used to convert units from A/D 
converter back to rad/s, and essentially unitize 
angular rate feedback gain; also to convert feed- 
back from motor rad/s to manipulator rad/s to 
agree with input signal units 


by plotting the resultant root loous. If the stability or transient re- 
sponse is degraded too much, the gains for that particular joint can be 
reduced or a simple algorithm can be used to compute the inertia change 
as a function of manipulator joint configuration. An additional factor 
to consider here is the change in inertia when manipulating a large object. 


1 . Comments on Joint 3 

Joint or link 3 is the only sliding rather than rotational joint. 
It has the conventional motor drive, with a 0.563-in. radius shaft 
for driving the linear motion arm. Thus, the weight of the moving 
part is essentially the mass, and the radius of gyration is the radius 
of the drive shaft or gear. The joint can then be treated like all 
the rest in terms of servo control and computation of K-| , K 2 , and K 3 . 
Both its rate and position feedback are obtained from rotary sensors 
mounted on the motor shaft, so that there is no gear reduction for 
position as with all the other joints. The input function in terms 
of inches has to be converted to radians by dividing by the radius 
(0.563 in.). 


2. Truncation of A/D and D/A Converters 

All the A/D converters are 13-bit devices, 1 sign bit and 12 
data bits. A 10-V input into the A/D results in full-scale output or 
2 I 2 _ 4096 output units. Since the angular position potentiometer sensi- 
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tlvity is 3 . 27 ^ V per manipulator radian, full-scale output represents 
± 3 * 05 ^ rad. The resultant truncation is ±3,05^A096 = 0.7^5 mrad for 
all joints except 3. The angular rate sensitivity (referred to the 
manipulator rather than the motor) and the resultant truncation differs 
for some Joints as indicated in Table 2. 

The D/A converter is a 10-bit device with one sign bit and 9 
data bits. Full-scale input of +29 z +512 results in 10 V output. 

The truncation is then 0.0195 V, which can be converted to amps using 
the Aj values from Table 1 or to other units using the proper parameters. 


B. STABILITY 

The characteristic equation is obtained from Eq. (1) by combining the 
given Laplace transforms of through Gs to obtain all the starred transforms, 
and then converting them to their corresponding Z transforms. At this point, 
it should be made clear that modified Z transforms will be used since we 
are analyzing a sampled data system with fixed delay; i.e., the position 
and rate feedback data for one manipulator joint are read in essentially 
simultaneously, and operated on to compute the output error signal, which 
is then sent out to the drive motor prior to repeating the process for the 
remaining five joints. Thus, a fixed computation delay Tjj is present, and 
t5,oi total sampling interval T is determined by the time required to process 
all six joints. 


Table 2. Truncation of A/D Converters 


Joint 

Full-scale rate 

Rate 

truncation 

motor rad/s 

manip rad/s 

mrad/s 

deg/s 

1 

294 

2.94 

0.72 

0.041 

2 

227 

2.27 

0.55 

0.032 

3 

2.82 

2.82 

0.69 

0.039 

4 

156 

2.17 

0.53 

0.030 

5 

159 

2.21 

0.54 

0.031 

6 

400 

2.74 

0.67 

0.038 
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The individual modified Z transforms for the denominator of Eq. ( 1 ) 


are: 


-G5G2Gho(Z) = T 


mZ - m + 1 


Z(Z - 1 ) JKt 


t 2 m 2 z 2 + Z(- 2 m 2 + 2 m + 1 ) + m 2 . 2 m + 1 Kxj' 

-GiGgGfiGhoCZ) ; 

2 Z(Z - 1)2 . JK' 


G3(Z) = - 
Gi,(Z) = - 


(Ky + KivDZ - Ky 

___ 

(Ke + KjgT)Z - Ke 


(Z - 1) 

The characteristic equation has the form 


A4Z^ + A 3 Z 3 + A2Z2 + AiZ + Aq = 0 


where 


All = 1 


I 3 = -3 + m(C 2 + C 3 ) + m2(Ci + C 4 ) 


( 2 ) 


A2 = 


Ai = 


An = 


3 + (1 + 2m - 3 m 2 )Ci + (1 - 3m)C2 + (1 - 2m)C3 
+ (1 + 2m - 2ra2)C4 

-1 + m( 3 m - l|)Ci + ( 3 m - 2)C2 + (m - DC3 + (m - 1 ) 2 ci| 
-(m - 1)2ci + (1 - m)C2 


and 


Cl = 


1 , 
- KpT2 
2 


® JK^ 


Co = 


C4 


KxJ 

KvT — 7- 
JKx 

KxJ' 

1 KxJ^ 

i ITi 
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Td 



1 

— = 0.1 (for T = a) 

T 62.5 


1 

— = 0.2 (for T = — a) 

T 125 

The next step is to program Eq. (2) and compute the roots as a function 
of the gains Kg, Ky, Kjy, Kig, the sampling interval T, and the delay 
from zero to one full cycle (T). An interesting presentation is given 
here for the case of zero delay. 

The Z-plane loci for constant Ky or consultant Kg are conveniently 
circles with origins at -1 and +1, respectively. The two radius equations 
are 


Ty = H - 2KyT - KjyT2 

Tg = (Kg + Kiy)T2 

where the gains are as defined previously. These expressions are exact 
for no integral gain (Kjg = 0), but they still apply for a large range 
(0—60,000) of Kje since the locus of the complex roots changes little, 
and only the real root moves along the real axis as Kj increases. 

This has, of course, been checked using Eq. (2) with no delay (m = 1). 


C. TRANSIENT AND STEADY-STATE STEP RESPONSE 

Section B introduced the system characteristic equation, which, 
for specific gain values, indicates the relative stability in berms of 
location of the roots of this equation in the Z-plane unit circle. This 
information is sometimes sufficient in itself, but usually it is desira- 
ble to analyze the control system response to step inputs. In this case, 
we are interested in response to steps of position A0 and disturbance 
torque T(jQ. The transient response in terms of rise time, overshoot, 
and damped oscillation frequency, along with the final steady-state re- 
sponse to these inputs, is very useful information. Also, the actual 
measured response obtained by applying these step inputs to the physical 
system is a good indication of the accuracy of the system model and the 
understanding of its performance. 


1. Step Displacement Transfer Function 

Equation (1) can be used to obtain the desired transfer function. 
However, a slight modification is necessary since the second term in the 


3-11 


77-66 


numerator contains the differentiation e.emcnt (Gg). Normal inputs are 
polynomials in Joint angle as a function of time (nT). Thus, the analytic 
differential can be easily computed , bub a step input is never used by the 
trajectory program and certainly not differentiated. Therefore, we can 
think of an input step as a displacement error which occurs when the 

loop is initially closed. The result is the elimination of the second 
term in the numerator since it has no effect on this input. 

For a step displacement input 


A0i(z) = A0 

Z - 1 

the output response is 

A3iZXm2z2 + (-2m2 + 2m + 1)Z + (m - 1)2] [(C^ + C4>Z - Ci3 


0q(Z) = 


(Z - 1) [A4Z*< + A3Z3 + A222 + A-jZ + Aq] 


0o(2) = 


A0i(B4Z'< + B 3 Z 3 + B2Z2 + BiZ) 


(3) 


where all the parameters are as defined in Section B. To obtain the 
transient response as a function of nT, it is necessary to expand 
Eq. (3) to the following form; 


+ (A3 ~ A4)Z*^ + (A2 - A3 )z 3 + (A-) - A2 )z 2 + Aq - A'j)Z - Aq 


in) 


where 

B4 = m 2 (Ci + C4) 

B3 = (1 + 2m - 3m2)C-| + (1 + 2m - 2ra2)C4 
B2 = m(3ra - + (1 - m)2c4 

Bi = -(1 - ;n)2c-i 

Division of Eq. (il) is easily programmed on a computer and the 
step response obtained for a specific set of input parameters. If 
the final value theorem is applied to Eq. (3), 

(Z - 1) 

Oo(nT) = 0 q(Z) 

n— CO Z Z— 1 

2C4 

= A0^ = AG, 

2CH 

as would be expected for an input step A0^. But if Kje is zeroed, 


3-12 



77-66 


2Ci Ke 

Oo(nT) = ^0^ s AOi 

rwra 20^ + C 2 Kg 4. Kjy 

Indioating that the rate integral gain (Kjy) has to be zero or the 
output will not reach ^ 0 ^, 


2. Step Torque Disturbance Transfer Function 

Each manipulator Joint control system is subject to disturbance 
torques, some Joints more than others. These torques can be due to the 
hand encountering an object, gravity effects, inertia reactions from 
other Joints during movement, and, in this case, very large and changing 
friction torques in the harmonic drive reduction gears. It is important 
to know the transient and steady-state response to these torques, which 
are generally not pure step inputs, but the step response analysis is 
quite sufficient for selecting proper gains for optimum response in 
conjunction with stability margin requirements. 

The output response for an input torque is 




G2G-|G9TjJq 


1 - 


g!!g g g* 


- G.G„G„G G 


( 5 ) 


3 5 2 ho ra 8“ho 4 


The torque 'r refers to an output torque and has to be multiplied by 
the gear stepdown ratio n to reference it to the motor shaft. Then it 
must be multiplied by the torque-to-current conversion factor Gg, which 
results in a numerator 


G2GiG9tJo(s) = “G2Tdo(s) 

Here, G 2 is th^ niotor transfer function K^/Js^ and is not multiplied by 
the constant J/K^ as in the previous derivation for an input 0^ (Eq. 1). 
Letting the torque input be a step torque results in a numerator 


• . . do 

®2°l‘^9”’’do(s) = — (6) 

Js3 

The Z-transform of Eq. (6) la 

n2TdoT2[m2z2 + {-2m2 + 2m + 1)Z + (m - 1 )2] 

G2GlG9Tdo(Z) = (7) 

2J(Z - 1)3 


Making all the denominator substitutions in Eq. (5) as was done in 
Section C-1 results in a factor of Z transposed to the numerator, and 
the final transfer function for a step torque is 


3-13 


77-66 


n^TdoTS [m2z2 + (-2m2 + 2ra + 1 )z2 + (m - l)2z] 

0O(Z) = ^ ;;; (8) 

Aj|Z^* + A3Z3 + A2Z2 + A^Z + Aq 

where the denominator coefficients are as defined in Section B andT 
has units of ounce-inches if J is in ounce-inoh-seoonds squared, Again 
the transient response can easily be obtained by programming the division 
of Eq, (8) for a specific set of parameters. 

It is of interest to apply the final value theorem to Eq. (8), 
assuming nonzero values for all the gains: 


(Z - 1) 

Oo(nT) = OoU) = 0 

n— CO Z 2—1 


Thus, for a step torque, a transient error in 0 q occurs but decays to zero. 
But if the position error Integral term Kjg is zero, the output error 
becomes 


0o(nT) 
n— CO 


^^^doT^ n2idoKT 

J(2Ci + C3 ) " J^KtCKq + Kiv) 


(9) 


For a 10 ,000-oz-in . step torque, an inertia (J) of 0.03^ oz-in,-s2 
(J^ multiplier = 0,034 and K^/Kj = 1), a gear reduction ratio of 1/100, and 
a Kg value of 3600, the steady-state position error from Eq. (9) is 0.47 
deg. With any value of Kjg inserted, this error decays to zero, but 
a larger value of Kje will cause it to decay faster. Some of these torque 
response charaoteristics are given in the Appendix. It should be noted 
from Eq. (9) that the magnitude of the steady-state error with no Kjg, 
and even the magnitude of the transient response to a step torque with 
Kjq in, will vary for each joint as a function of the gain multiplier 
and the ratio Kj/K'f. Generally, Kx/K-j will be unity; therefore, the error 
is determined by the factor n2/j' since each joint will have the same 
Value of Kg and Kjv as selected from the root locus plots. 


The above discussion of the transient position error due to a 
disturbance torque indicates why it is important to analyze such re- 
sponses as well as select proper gains for stability. Every manipulator 
joint should operate with the same gains (Kg, Ky, Kjg, Kjy) and have the 
same locus of roots, but as Indicated above, the error due to a disturbance 
torque will be a function of the factor n2//, which differs for most of 
the joints, as indicated in Table 1. It is important to consider this, 
since reaction torqria are reflected back to each joint during movement. 

Of course, these are reduced by the gear reduction ratio n. A more sig- 
nificant effect is from the varying friction torque. This torque is not 
reduced by n and is a real problem if it is high and the gains are low, 
resulting in an undesirable rough motion. Table 1 indicates why joints 
3 through 6 are particularly susceptible bo this type of disturbance as 
shown by their relative high values of n/J^ , The parameter n is not 
squared here since it is tASsuraed that the friction torque is not reduced 
by n, but the resulting transient position error is referred to the output 
by the remaining n factor. 
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SECTION IV 

DISCUSSION OF STABILITY AND TRANSIENT RESPONSE AS A FUNCTION OF GAINS 


The data to be suninarlzed here conaista of a aerlea of root looua 
plota and branalent atep responaea preaented in the Appendix. Thoae 
are only a very amall fraction of the total plota generated during 
the extended atudy of thia ayatem. No attempt will be made here to 
analyze and compare each aucoeaaive ayatem. The important point la 
to analyze the present and, it is hoped, final system configuration. 

This final system is one which has a sampling rate of 125 per second 
and about ZQ% delay. Unfortunately, the Increase in sampling rate 
from 62.5 to 125 occurred after the analysis was completed. The bulk 
of the plots therefore pertain to a system with a sampling rate of 
62.5 and 10;^ delay. A few computer runs were made at the higher sampling 
rate to Justify a reasonable set of gains, but a thorough set of locus 
plots was not obtained. This is not necessarily a problem since 
the data presented should give a good insight into the system response. 

The discussion of stability and transient response here will 
refer to each figure from the Appendix in turn. 

The Z-plane unit circle is displayed in Fig. A-1 with constant 
damping ratio and constant damped frequency radii superimposed, For 
a simple second-order system, the damping ratio (C) and damped frequency 
(ai(j) apply directly to any set of complex roots in the unit circle. 
Higher-order systems will not produce the simple second-order response, 
but the complex pole location is still very informative since the relative 
location of two sets of poles gives some insight into the transient 
response to displacement errors and disturbance torques. The damped 
frequency, which is Indicated as a function of the sampling frequency, 
is particularly important in estimating the response time to input 
disturbances. 

Zero-delay loci are shown in Fig. A-2 to indicate the very high 
gains and fast response possible. Of coure, zero delay is not obtainable 
at such high sampling rates since it takes time to compute the error 
signals. The interesting aspect is that the loci are circles with origins 
at -1 and +1 and are easily drawn for any value of Kg, Ky, and Kiy 
It should be noted that these loci apply only for zero position integral 
gain Kjg and a sampling rate of 62.5 per second. 

The zero-delay loci in Fig. A-3 are presented only to show the 
change for the higher, 125 sampling rate. The radii r^ and r^ for 
a specific complex pole location are shown to indicate that, given 
these magnitudes and selecting one gain, the other two gains can be 
computed using the given equation. 

An arbitrary point on the loci of Fig. A-3 was selected in 
Fig. A-J) and the integral gain then varied from zero to 80,000. The 
system is still stable {for zero delay), but obviously the complex 
root moves toward leaser damping and stability margin as the integral 
gain Increases. 
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Figure A-5 presents the first loci with delay other than zero. 

The delay Tp/T is varied from zero to 0,30 to show how the system becomes 
unstable as the delay becomes larger than 0.30. The zero-delay point 
should coincide with the pole location for this sot of gains in 
Hg. A-3. 

In Fig. A-6, wo have complete loci for a 105( delay and sampling 
rate of 60 per second. It indicates how radically the loci for zero 
delay in Fig. A-3 distort as the delay changes from zero. These loci 
are only for one pair of complex roots. There is another pair of complex 
roots at the lower frequency, but it is not shown here. 

Both complex roots are shown in Fig, A-7 for three sets of gains. 
The position integral gain Kie is then varied from zero bo 30,000, 

The interesting point here is that the higher-frequency complex pole 
hardly moves, but the lower-frequency one, which is indicative of the 
system response to a step torque, moves toward lower damping, which 
implies more overshoot in the step response. 

Since the inertia is no longer computed, the average value used 
may not always equal the actual changing value. This has the effect 
of multiplying all the gains by the ratio J/'J. Figure A-8 shows the 
destabilizing effect and the interesting fact that one root becomes 
less stable as J/'J increases, but the other root becomes leas stable 
as decreases. 

Figure A-9 shows complete loci for 10?t delay and the rate integral 
gain Kjv set to 1000. It should be compared to Fig. A-6 to show how 
the loci change as Kjy is changed from zero. Other loci were plotted 
for values of Kiy larger than 1000 and indicate a shift upward toward 
less stability, as would be expected. 

Both complex roots could not be shown in Fig, A-9; therefore, 
three sets were selected in Fig. A-10 to indicate their movement as the 
position integral gain Kjg is varied from zero to 30,000, This is 
a repetition of Fig, A-7 only with different gains; in particular, 

Kiv ia now 1000 Instead of zero. The results ?re similar in that the 
higher-frequency root changes little, but the lower-frequency root 
moves toward less damping. 

The set of loci in Fig. A-11 is the same as that in Fig. A-8, only 

for different gains, and Kiv is equal to 1000 rather than zero, A^ain, 

the higil^ier-frequency root moves toward less damping as the ratio J/J 
increases, but the lower-frequency root moves toward less damping as 
decreases. 

In Fig. A-12, the first loci for a sampling rate of 125 per second 

show the same destabilizing effect as the delay changes from zero bo 

30%. The gain sets were used arbitrarily only for illustration since 
neither set is very stable as the delay is much above 10%, 

The loci shown in Fig. A-13 can be compared to those in 
Figs. A-1; and A-10, which also show the effect of varying the position 
integral gain Kig. The sampling rate here is 125 per second, and 
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the gain sets wore arbitrary, although all throe sots could bo used. 
However, set A would have to use a reduced Kjq, probably less than 
^ 10 , 000 . 

The four step displacement responses in Fig. A-1^1 show the faster 
response with larger position gain K0 and also the overshoot increases 
with added position integral gain Ki^. These and the ones shown in 
Fig. A-15 are mainly for comparison purposes since the delay here is 
zero, 


The faster response gain set from Fig. A-'i4 is used in Fig. A-15 
to illustrate the better response, to a step torque disturbance, as 
the position Integra', gain is increased. However, response D indicates 
possibly undesirable overshoot as Ki© gets very large. Also, one has 
to consider the consequent position error overshoot shown in Fig. A- 1^1 
as Kje increases in magnitude. 

The responses in Figs. A-I6 and A-17 are more realistic than 
the previous two since the delay is IO56 with a sampling rate of 60 
per second. This is the actual case with the manipulator, unless the 
125-per-second sampling rate is used, which means the delay is 20it. 
Figure A-16 is interesting in that it shows the effect of the rate 
integral gain Kiy on the position step response. In general, a large 
value of Kjv will alow the position step response and eliminate the 
overshoot. As Ki© is increased, the response increases but still avoids 
any significant overshoot. Response A shows that with zero integral 
gain the response will reach only a fraction of the input, by the ratio 
of Ke/(Kg + Kjy) , 

The response curves in Fig. A-17 clearly show the rapid increase 
in recovery from a step torque as the position integral gain (Kje) 
is increased. The maximum value used is determined by the amount of 
overshoot one is willing to tolerate. 


4-3 


77-66 


SECTION V 

SUMMARY AND CCiJCLUSIONS 


The sampled data eonti-ol system used for each of the Joints in 
the JPL manipulator has been described in detail in terms of root loMts 
plots and trar?sient step responses. The mathematical derivations of 
the various transfer functions are presented j as are all the hardware 
parameter values. The derivations are for a sampled data system with 
fixed delay, employing position and rate feedback and current drive 
for the d.c. drive motor in each joint. Position and rate integrals 
are computed in the manipulator software, as is the in^ut drive function 
which defines the Joint movements as a function of time. 

A small fraction of the root locus plots generated is presented 
In the appendix, and indicates relative stability as a function of: 

(1) Computation delay (10 to 30$ of sampling interval). 

(2) Position gain, rate gain, position integral gain, and rate 
integral gain. 

(3) Inertia change (±40$). 

(4) Sampling rate (62.5 and 1?5 per second). 

A sample of the transient responses to input steps of position 
and torque is presented in the appendix. These transient responses 
indicate the response time variation as a function of the position 
and Integral gains. 

Baaed on tiia data presented here, it can be concluded that the 
performance of the manipulator can be made to conform to criteria calling 
for very fast response by increasing the gains properly, as indicated 
in the root locus plots and transient responses; e.g., a response time 
constant of less than 0,1 s can be obtained with a sampling rate of 
60 per second', 

An important feature of this analysis is that the various hardware 
gains and parameters such as inertia of motor torque constant have 
all been normaliiied by using their reciprocal values as gain multipliers 
in the software. Thus the gain Val'«>'cs used throughout this analysis 
wijl apply to any similar control system after its hardware gains have 
sii.-xlarly been eliminated or considered as part of the total loop gain 
defined here. 
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APPENDIX 

ROOT LOCI AND TRANSIENT 'RESPONSE CHARACTERISTICS 
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Figure A-2. Loci for Zero Delay and Zero Integral Gains With 
Sampling Rate of 62.5 per Second 
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Loci for Zero Delay and Zero Integral Gains With 
Sampling Rate of 125 per Second 


Figure A-3 


Locus for Zero Delay as Function of Integral Gain Kje 


Figure A-4 










Figure A-6. Loci for 10% Delay and Zero Integral Gains With 
Sampling Rate of 60 per Second 
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Figure A-7. Typical Loci of Both Complex Roots With lOt Delay 
as Function of Integral Gain 



Figure A-6 . Typical Loci of Both Complex Roots as Function of 
Ratio of Inertia Multiplier J' to Actual Inertia J 
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Figure A-9. Loci for 10X Delay, Kiy x 1000 and Zero Kj* 
With Sampling Rate of 60 per Second 





Figure A-10. Typical Loci of Both Complex Roots With 104 Delay 
and Kjv s 1000 as Function of Integral Gain Kje 
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Figure A- 11 


Typical Loci of Both Complex Boots as Function of 
Ratio of Inertia Multiplier J' to Actual Inertia J 


Figure A-12. Typical Loci as Function of Delay With Sampling 
Rate of 125 per Second 
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Figure A-13> Typical Loci as Function of Integral Gain Kj« With 
Sampling Rate of 125 per Second 



Figure A-14. Transient Response to a Step Displacement of 0.5 deg 
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figure A-17. 
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